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ABSTRACT 

Two Extended Kalman Filter algorithms for air-to-air 
passive ranging are proposed, and examined by computer 
simulation. One algorithm uses only bearing observations 
while the other uses both bearing and elevation angles. 

Both are tested using a flat-Earth model and also using a 
spherical-Earth model where the benefit of a simple correc- 
tion for the curvature-of-the-Earth effect on elevation angle 
is examined. The effects of varied angle measurement 
precision and of varied range estimate accuracy are inves- 
tigated. Both filters are found to perform acceptably under 
most conditions, with the bearing-elevation algorithm 
generally providing superior results. 
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INTRODUCTION 



I . 

The problem of Fleet Air Defense and air defense in 
general is one covering increasingly large geographical 
areas due to the greater speeds, ranges, and missile launch 
envelopes of potentially hostile airborne attack platforms. 
Concurrent with the expansion of the physical size of the 
problem has been an increase in its complexity particularly 
in the area of Electronic Warfare (EW) . 

A common effect of EW is the denial of range and range 
rate information by electronic jamming of the observer's 
radar system. Since target range and range rate must 
generally be known or at least estimated for a fighter to 
successfully employ its missile system, the fighter must 
have some alternate means of obtaining that information. 

An approach to this problem is called Passive Ranging 
(PR) or passive Target Motion Analysis CTMA) . This might 
involve one or more observers using a "receive-only " radar 
mode or perhaps a highly directional infrared (IR) sensor. 

It could entail such things as; (.a) triangulation of 
bearing observations from more than one observer, (.b) use of 
one or more known target parameters (with continued bearing 
observations) to compute the other parameters, (c) use of 
direct bearing and elevation angle observations in combination 
with observations of radio frequency (RF) energy reflected 



10 



from the water or Earth's surface, and/or (d) a series of 
observer maneuvers used in conjunction with angular observations. 

Determination of a target's position and motion by means 
of calculations performed on observations of only bearing 
(and possibly elevation) angles is confounded by the reality 
that the angle measurements are noisy. That is, while a 
series of measurements may be centered on the true values, 
individual measurements will differ from the true values by 
varying amounts and in a random way. This type of PR prob- 
lem may be thought of, then, as having two major facets: 
first, from the series of measurements the observer must 
make "best guesses" as to the true angle values; and second, 
using these estimates, he must solve a dynamic geometry 
problem to ascertain target position and motion. 

A "good" system for passive ranging will determine 
target parameters using only its own observations, but it 
might reasonably be expected to also make use of any a 
priori targeting information to improve its speed and/or 
accuracy of solution. A method for doing this is by means 
of a Kalman Filter (KF) algorithm in which the prior infor- 
mation is utilized along with an estimate of how accurate 
that information is. The KF (or, more precisely, the Ex- 
tended Kalman Filter CEKF) ) is successfully employed presently 
in the submarine and surface ship anti-submarine warfare 
communities. In this environment observations are normally 
acoustic bearing measurements, although the use of 
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depression/elevation angle with "bottom-bounce" reflections 
has been utilized or proposed. 

Representative of current thinking on passive ranging as 
an air-to-air problem are techniques proposed by Ohlmeyer 
[Ref. 1] , and Stiffler [Ref. 2] , which also rely on the use 
of EKF's. Ohlmeyer 's technique uses only bearing angle 
information, whereas Stiffler presents six different algorithms 
using bearing-only or a combination of bearing and elevation 
angle observations. 

This paper proposes and investigates methods of passive 
target motion analysis by means of two EKF's, where both 
bearing-only and bearing-elevation solutions are computed 
simultaneously for comparison purposes. 
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II. THE KALMAN FILTER AND EXTENDED KALMAN FILTER 



A. THE KALMAN FILTER 

The following discussion briefly describes Kalman Filter- 
ing in general, the need in our case for the Extended Kalman 
Filter, and an application of the EKF to the air-to-air 
passive ranging problem. The reader interested in a more 
in-depth development of the KF and EKF is referred to 
References 3 , 4 , and 5 . 

The purpose of a KF is to keep track of the state of a 
system by means of a sequence of noisy measurements. This 
is done by recursively updating an estimate of the state by 
computationally processing the succession of noisy observa- 
tions in such a way as to reduce as much as possible the 
effect of measurement errors. For our purposes we will 
assume that the object (target) whose state we are esti- 
mating, and the observer (fighter) exist in a Cartesian 
coordinate system and that the state, S, is composed of a 
four- or five-element vector of the form; 



X 



X 



Y 



Y 



S 



X 



or S 



X 



( 2 . 1 ) 



Y 



j 



Y 



A 
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where X and Y are the X and Y components of target velocity, 
X, Y and A are the X, Y and altitude components of target 
position; and where the true values of X, Y and A are assumed 
constant. Note that the KF in general is in no way limited 
to this type of reference frame or state vector, and that 
observations from which the estimated state is computed need 
not have the same dimensionality or units as the state 
vector. In our case, for instance, each observation will be 
either a bearing angle measurement or a vector of both 
bearing and elevation angle measurements. 

The KF is a predictor-corrector type estimator that 
propagates an estimate, )J , of the state, S, and an associated 
covariance matrix, J, reflective of the accuracy of the 
state estimate. The KF algorithm is implemented in two 
alternating stages. First, previous estimates of \i and 'l 
are extrapolated one time-step ahead based on the assumed 
system dynamics; this we will refer to as the Movement Step. 
The extrapolated quantities are then used to compute a set 
of optimum weights called Kalman Gains (simply proportion- 
ality factors) . These are applied to the prediction and to 
a new observation in a Measurement Step, which provides an 
updated (corrected) estimate of the state and its covariance. 
The process is then repeated. 

Symbolically, the KF algorithm may be written as follows: 
Movement Step: 

U. = 4 C2.2) 
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(2.3) 






^ L_l + Q 



Kalman Gain computation: 



K. = y h'^(H y . + P) 

3 Z. Lj 



Measurement Step: 



/s ^ .V, 

y. = y.+K.(Z-y - Hy.) 

3 3 3 V ^3 







(I - K.H)I. 



(2.4) 



(2.5) 



( 2 . 6 ) 



The notation is as follows: 

$ is the transition matrix which describes how the 
system state changes between observations, 

H is the transition matrix which describes how the 
measurement depends on the state, 

y / Q» y / and P are respectively, movement noise mean 
and covariance, and measurement noise mean and covariance. 
(Note that movement noise and measurement noise are assumed 
to be normally distributed random variables, i.e., 

W ~ N(y^,Q) and V ~ N(y^,P)). We will generally assume here 
that y , Q, and y are zero. 

w V 

K is the Kalman Gain, 

Z is the observation (measurement) , 

I is the identity matrix. 
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j is the observation time index, 

T (as superscript) indicates transpose, 

~ and ^ indicate estimates after Movement and Measure- 
ment, respectively. 

B. THE EXTENDED KALMAN FILTER 

The above described KF is appropriate when both the 
movement and measurement models are linear functions of the 
state variables. We have, however, a non-linear measurement 
function since 



Z = h(S) + V 



where the measurement, Z, is a function, h(S), of system 

state plus some noise (error) , V, and where h is composed of 
# 

one (or two) arctangent functions of state vector elements. 
We have; 



h(S) 



j^tan ^ 



AY 



in the bearing-only case, and 



h(S) 



tan 



AY 



tan 



AA 



(AX^+AY^) 



in the bearing- 
elevation case, 



where AX, AY, and AA are, respectively, the X, Y and altitude 
differences between fighter and target positions. 

Since the measurement in both the bearing-only and 
bearing-elevation cases is a non-linear function of the 
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current state vector, the measurement transition matrix H 
in the KF algorithm must somehow be "linearized". This is 
accomplished by expanding h in a Taylor Series about a known 
vector that is close to the true state S. For this known 
vector we will use y , our current estimate of S. Truncating 
after the first two terms of the Taylor Series we have that 



h(S) 



h (y) 



+ 8h(S)/3S 



S=y 



The effect on the KF algorithm is that in Equation 2.5 
Hy^ is replaced by the function h(yj) which is the measure- 
ment vector as a function of the state estimate, and in 



Equation 2.4 and 2.6 H = 3h(S)/3S 



One condition re- 



S=y 



quired here is that the estimate be unbiased, i.e., y^, 
the estimated value of V, must be zero [Ref. 3] . 

This extension of the KF to the non-linear case is 
appropriately called the Extended Kalman Filter (EKF) . 
Higher order, more precise approximations to the optimal 
non-linear filter can be achieved using more terms of the 
Taylor Series expansion for the nonlinearities, and by 
deriving recursive relations for the higher moments of S. 
See Reference 3 for a discussion of methods of this type. 

The (non-extended) Kalman Filter is optimal when its 
assumptions are valid [Ref. 6J , however, this is not neces- 
sarily true of the EKF. Since, in our case for instance, 
the measurement transition matrix H both depends on the 
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current state estimate and is used to obtain revised state 



estimates, there is a potential for bad estimates to get 
worse and for complete loss of track to occur [Ref. 7] . 

Also, the matrix ^ is only an approximation to the true 
covariance matrix and is not always an accurate indicator of 
the estimation errors. Fortunately, however, the EKF has 
been found to perform well in a number of practical applica- 
tions [Ref. 3] including passive ranging. 

The design of practical, operational filters "is an art 
wherein one attempts to retain the behaviour of the EKF when 
things are going well, while simultaneously being able to 
recognize and correct for incipient loss of track" [Ref. 7] . 
Techniques for doing this (and cautions) are discussed later 
and in References 1, 3 and 8. 

C. FUNCTIONS AND MATRICES 

Functions and matrices are given here for the bearing- 
elevation cases. Those for the bearing-only cases are 
exactly the same, but excluding the last Cfifth) element 
in the case of a vector, and the last row and column in the 
case of a matrix. 

With u as the estimate of the state vector 

• • T 

S = [X,Y,X,y,A] , we have that the movement function 
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g(S) 



S=y 



/ X. 

I 1 


■<- 


I — 1 

1 

•H 

X 




1 Y. 

1 ^ 


-<r- 


^i -1 




< X. 




X. , 


+ Atx. , 


^ 1 




1-1 


1-1 


Y, 




Y. T 


+ AtY. , 


1 




1-1 


1-1 


u, 


4- 


1 — 1 

1 

•H 





so the movement matrix is 



$ = 



1 

0 

1 

0 

0 



0 

1 

0 

1 

0 



0 

0 

1 

0 



0 

0 

0 

1 



0 0 



0 

0 

0 

0 

1 



The covariance matrix is 



I = 



a? 

X 

0 

0 

0 

0 



0 

0 

0 



0 

0 

a: 

0 

0 



X 



0 

0 

0 



0 

0 

0 

0 



The measurement function is 



h(S) 



S=y 



tan ( 






Py-Fy 



tan ( 






R 
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2 2 1/2 

where ]j p, = ( ( ^ where F^, F^, and 

F^ are, respectively, the fighter's known X, Y, and altitude 
positions, so the measurement matrix is 



H(S) 



S=y 









^x"^x 



■'R 



-(y^-F^) (tiy-Fy) 
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III. PARAMETERIZATION AND ASSUMPTIONS 



A. FIGHTER AND TARGET FLIGHT PATHS 

For all simulated tracking sessions the fighter utilizes 
a "zig-zag" pattern as described in Appendix B and illus- 
trated in Figure 3.1. Briefly, this pattern has the fighter 
initially turn so as to have the first bearing observation 
0.7 radians (about 40°) right of dead ahead, hold this 
heading for 1 minute, then turn to put the most recent bearing 
0.7 radians left, now continuing for 2 minutes. Alternating 
2-minute legs are continued until a specified number of 
observations have been taken, or until the target passes by 
the fighter. The target, meanwhile, in all cases maintains 
a non-turning constant altitude track. For the computer 
simulation runs each tracking session is limited to 5 minutes 
(61 observations at 5-second intervals). 

B. INITIAL PARAMETERS 

Eighteen different combinations of P and ^ values (that 
is, covariances for observation error and state estimate) 
are utilized for initial parameterization in the simulations. 
The runs are first done using the "flat- Earth" motion model, 
then they are all repeated using the spherical-Earth model 
with an elevation angle correction (Appendix D) , then twelve 
cases are simulated using the spherical-Earth model without 
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POSITION (NM) 




Figure 3.1. Fighter and Target Flight Paths 
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the elevation correction, and finally, three cases are simu- 
lated where a 5° constant bias is added to the angle measure- 
ments. 1000 replications of each set are run for both the 
bearing-only and bearing-elevation cases. In all cases the 
target, at time 0 , is at 80 nautical miles (nm) range, heading 
directly toward the fighter at an altitude of 7nm (42,532 
feet) and a ground speed of 500 knots. The fighter maintains 
an altitude of 3nm and a ground speed of 300 knots. The EKF 
initial estimates of target state for each run are varied 
randomly according to a multivariate normal distribution 
centered at the correct values, and with covariance as stated 
below. 

At each observation the bearing-only (BO) and bearing- 
elevation (BE) EKF's are fed identical random azimuth 
measurements, while the BE EKF additionally gets random ele- 
vation angle measurements. The random measurements are 
generated by adding to the true angle a random nxamber from 
a normal distribution with mean 0 and variance P. 

The P-values used are 5^, 2^, 1, .5^, .1^, and .02^ 

2 

degrees , where these values apply to both bearing and, 

where applicable, elevation measurements. For example, in 

the first set of bearing-only simulations P = [25] whereas for 

25 0 

the bearing-elevation runs P = [ ^ 25 J • We assume here 

that both bearing and elevation measurements have the same 
magnitude and distribution of errors (normal) , and that 
they are independent of each other . 
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The initial estimate of the covariance matrix has diagonal 

values: o? = 1000 knots^, = 250,000 knots^, = 4nm^, 

X Y X 

2 2 2 2 2 
and a, = 4nm , while o„ is varied from 1600nm to 400nm 
A Y 

2 

to lOOnm for the different cases. The choices for these 
values as well as for the P- values are somewhat arbitrary 
and their validity will not be argued here. The reader is 
referred to Appendix B for a description of how the reference 
frames (coordinate systems) are defined, and of how true 
positions and observation angles are computed. 

C. ASSUMPTIONS 

For EKF computer simulations the following assumptions 
are made : 

(1) The observer (fighter) knows his own position, 
course and speed precisely. 

(2) Maneuvers are instantaneous; there is neither time 
loss nor positional change associated with the 
observer's course changes. 

(3) The target holds a constant course, speed and 
altitude, while the fighter holds constant speed 
and altitude. 

(4) There is no refraction or other distortion of the 
radiated energy. 

(5) Angle measurement errors in elevation and in azimuth 
have a Gaussian (normal) distribution with zero mean 
and known variance. Errors are assumed to be inde- 
pendent of range. 
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IV. SIMULATION RESULTS AND OBSERVATIONS 



A. TABLES 

Results of the computer simulations are summarized in 
Tables I-IV which are for, respectively, the planar ("flat- 
Earth") motion model, the spherical-Earth motion model with 
elevation angle correction, the spherical model without 
elevation angle correction, and, finally, the spherical 
model with elevation angle correction, but with a constant 
angle bias inserted into the observations. Data in the 
tables are categorized by initial range variance, and for 
each range variance the different selections of angle measure 
ment precision are represented, with data from the bearing- 
only EKF on the left and from the bearing-elevation EKF on 
the right. 

Comparison data are the proportions of dropped tracks 

using three different criteria. First is the "e > 3o" column 

which lists the proportion of runs in which actual range 

error was greater than the 3 standard deviations as estimated 

by the EKF, i.e., e = IR-R] > 3a. (See Appendix A for a 

2 

description of computations of R and a_.) The "Rg" column 
lists as dropped tracks those for which the final range esti- 
mate is in error by more than 25% of the true range, and the 
"Rg-Vel” colrmin lists those for which either range or 
velocity are in error by more than 25% of actual values. 
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TABLE I 



Simulation Results — "Flat-Earth" Motion Model 



Proportion of Dropped Tracks 
(by criterion) 

1000 Replications 

Bearing-only Bearing & Elevation 

2 2 

Initial Range Variance = )^(4,4) = 40 nm 



2 

P Degrees 
Measurement 



e>3a 


Rg-Vel 


Rg 


Precision 


e>3a 


Rg-Vel 


Rg 


0.188 


0.949 


0.732 


^2 


0.075 


0.880 


0.554 


0.085 


0.757 


0.452 


2^ 


0.047 


0.473 


0.169 


0.094 


0.480 


0.175 




0.073 


0.206 


0.059 


0.124 


0.235 


0.109 


.5^ 


0.118 


0.137 


0.076 


0.217 


0.179 


0.128 


.1^ 


0.208 


0.153 


0.092 


0.387 


0.177 


0.138 


.02^ 


0.439 


0.168 


0.096 







I 


(4,4) = 20 


nm 






e>3a 


Rg-Vel 


Rg 


P 


£>3a 


Rg-Vel 


Rg 


0.121 


0.904 


0.710 


52 


0.042 


0.781 


0.504 


0.017 


0.664 


0.329 


2 ^ 


0.004 


0.347 


0.096 


0.006 


0. 32 8 


0.050 


I2 


0.004 


0.038 


0.001 


0.010 


0.083 


0.001 


5^ 


0.006 


0.009 


0.001 


0.066 


0.029 


0.007 


. j- « 


0.041 


0.016 


0.003 


0.241 


0.029 


0.007 


. 02 ^ 


0.184 


0.012 


0.001 






I 


(4,4) = 10 


2 2 
nm 






£> 3 g 


Rg-Vel 


Rg 


P 


£>3a 


Rg-Vel 


Rg 


0.131 


0.858 


0.713 


52 


0.032 


0.701 


0.484 


0.017 


0.501 


0.293 


2^ 


0.002 


0.203 


0.071 


0.011 


0.239 


0.0 30 




0.001 


0.018 


0.000 


0.003 


0.0 39 


0.000 


52 


0.004 


0.000 


0.000 


0.014 


0.002 


0.000 


. J- ^ 


0.006 


0.000 


0.000 


0.107 


0.001 


0.000 


.02^ 


0.037 


0.000 


0.000 
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B. OBSERVATIONS 



Some immediate observations can be made from the tables: 

1. From Table I ( "flat-Earth” Motion Model), the bearing- 
elevation results appear superior to those for bearing-only 
for every set of parameters when using either the range- 
velocity or range error criteria, and they are generally 
superior when using the e > 3a criterion as well. It should 
be noted, however, that in all of the cases represented the 
fighter-target altitude difference is held at 4nm (about 24,000 
ft) . The advantage of BE over BO was shown by limited addi- 
tional simulations to disappear as the altitude difference 
went to zero. 

2 . Improvement in the accuracy of the initial range 

2 2 

estimate (decrease in the variance ^(4,4)) from 40 to 20'^, 

2 2 

and then to 10 nm has a positive effect in decreasing the 
proportion of dropped tracks as one might reasonably expect. 

3. Improvement in angle measurement precision (variance 

P) generally improves the EKF's ability to track. It seems 

2 

evident, for instance, that P = 5 is impractical from an 

operational standpoint since neither EKF could determine 

target range and velocity within 25%, even 30% of the time 

regardless of initial range variance. It is interesting to 

note that the e > 3a dropped track criterion for the BE 
2 

EKF for P = 5 is exceeded in a much lower (2-10%) proportion 
of the cases than are the range and range-velocity standards 
(.50-95%) . This is a valuable trait in that, although the 
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TABLE II 



Simulation Results — Spherical Motion Model 
with Elevation Correction 



Proportion of Dropped Tracks 
(by criterion) 

1000 Replications 



Bearing-only Bearing & Elevation 

r 2 2 

Initial Range Variance = ^(4,4) = 40 nm 



P Degrees^ 
Measiironent 



£>3a 


Rg-Vel 


Rg 


Precision 


e>3a 


Rg-Vel 


Rg 


0.255 


0.937 


0.751 


^2 


0.121 


0.878 


0.592 


0.082 


0.718 


0.370 


2^ 


0.073 


0.466 


0.195 


0.076 


0.458 


0.145 


^2 


0.085 


0.159 


0.049 


0.125 


0.224 


0.106 


.52 


0.160 


0.139 


0.075 


0.231 


0.178 


0.120 


1^ 


0.440 


0.179 


0.111 


0.393 


0.170 


0.129 


.02^ 


0.858 


0.262 


0.174 






I (4 


,4) = 20^nm^ 









£>3a 


Rg-Vel 


Rg 


P 


£>3a 


Rg-Vel 


Rg 


0.238 


0.919 


0.752 


^2 


0.122 


0.808 


0.542 


0.027 


0.626 


0.252 


2^ 


0.010 


0.291 


0.078 


0.013 


0.350 


0.049 


^2 


0.012 


0.043 


0.004 


0.018 


0.084 


0.007 


.52 


0.034 


0.013 


0.003 


0.065 


0.027 


0.008 




0.247 


0.012 


0.006 


0.221 


0.028 


0.006 


2 

.02^ 


0.801 


0.078 


0.045 






1 (4,4) 


1^2 2 
= 10 nm 









£>3a 


Rg-Vel 


Rg 


P 


£>3a 


Rg-Vel 


Rg 


0.238 


0.842 


0.721 


52 


0.083 


0.663 


0.478 


0.024 


0.478 


0.233 


2^ 


0.003 


0.203 


0.066 


0.004 


0.219 


0.023 




0.005 


0.015 


0.000 


0.003 


0.047 


0.000 


.5^ 


0.006 


0.000 


0.000 


0.012 


0.001 


0.000 


.1 2 


0.142 


0.000 


0.000 


0.088 


0.000 


0.000 


.02 


0.742 


0.059 


0.050 
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EKF estimates of target state are not very accurate, the 
EKF is apparently "aware" of this since its estimated range 
variance is evidently high. Since the state covariance 
matrix is available to the user, he should generally be 
able to determine the worth of the estimated state information 
4. This characteristic does not necessarily hold true 
when measurement precision is extremely high, however; in 
fact, it becomes less true as P-values are decreased below 
.5^ for these EKF's (e.g.. Table I, ^(4,4) = 40^ and P = .02^) 
A similar observation was made in Reference 6. This apparent 
EKF trait may be explained by the Taylor Series approxima- 
tion used to linearize the Measurement Function (Chapter 
II) inducing more error than that added by the noisiness of 
the bearing measurements. The EKF-estimated range variance 
becomes relatively small because of the precise measurements, 
but the actual range errors are not correspondingly reduced 
apparently because of the EKF linearization approximation. 
Practical results are still quite good as evidenced by the 
still relatively small proportion of dropped tracks using 
the range and range-velocity criteria. With a longer obser- 
vation period, however, we might expect the estimated 
range variance to continue its decrease relative to the 
squared range error (.covariance collapse) , and we would 
anticipate more tracks being dropped. A possible solution to 
this problem, if highly precise angle measurements are 
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TABLE III 



Simulation Results — Spherical Motion Model 
Without Elevation Correction 



Proportion of Dropped Tracks 
(by criterion) 

1000 Replications 



Bearing-only Bearing & Elevation 





Initial Range 


Variance = ) 


■ (4,4) = 


2 

4 0 nm 




e>3a 


Rg-Vel 


Rg 


P Degrees 2 
Measuranent 
Precision 


e>3a 


Rg-Vel 


Rg 


0.079 


0.726 


0.356 


2^ 


0.079 


0.477 


0.126 


0.071 


0.420 


0.127 


1 


0.137 


0.239 


0.055 


0.108 


0.205 


0.090 


.5^ 


0.372 


0.130 


0.071 


0.219 


0.017 


0.129 


.1^ 


0.998 


0.166 


0.117 



I (4,4) = 20^nm^ 



e>3a 


I^-Vel 


Rg 


P 


£>3a 


Rg-Vel 


Rg 


0.035 


0.609 


0.254 


2^ 


0.028 


0.336 


0.044 


0.069 


0.156 


0.002 


1 


0.069 


0.156 


0.002 


0.011 


0.073 


0.006 


.5^ 


0.312 


0.022 


0.002 


0.053 


0.017 


0.002 


.1^ 


1.000 


0.005 


0.002 








1 (4,4) = 


2 

10 nm 






e>3a 


Rg-Vel 


Rg 


P 


e>3a 


Rg-Vel 


Rg 


0.023 


0.502 


0.237 


2^ 


0.027 


0.226 


0.050 


0.002 


0.222 


0.017 


1 


0.065 


0.098 


0.000 


0.006 


0.041 


0.000 


.5^ 


0.328 


0.019 


0.000 


0.008 


0.001 


0.000 


.1^ 


1.000 


0.000 


0.000 
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TABLE IV 



Simulation Results — Spherical Motion Model 
with Measurement Bias 



Proportion of Dropped Tracks 
(by criterion) 

1000 Replications 



Bearing-only Bearing & Elevation 

Initial Range VAriance = J (4,4) = 40 nm 

2 

Measurement Precision = P = .5 



AZ Elev 



e>3a 


Rg-Vel 


Rg 


Bias 


Bias 


e>3a 


Pg-Vel 




0.132 


0.238 


0.113 


0 


5 


0.520 


0.838 


0.235 


0.991 


0.999 


0.989 


5 


0 


0.865 


0.951 


0.759 


0.985 


0.999 


0.986 


5 


5 


0.747 


0.998 


0.749 



available, would be to use a higher order Taylor Series 
approximation as previously suggested. 

5. A comparison of Tables I and II indicates that spheri- 
cal motion target data can be accommodated by the flat- 
Earth EKF when an appropriate elevation angle correction 
is applied. At the very high precision levels, however, 
there is a notable degradation with the BE EKF results, 
especially when using the e > 3o criterion. This is apparently 
due to the filter being "confused" by highly accurate 
measurements which are "corrected" by an elevation angle 
correction (for Earth's curvature) which is no longer 
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adequate. The result is that estimated range variance is 
considerably smaller than actual range variance. 

6. A comparison of Tables II and III indicates that the 
BE EKF is somewhat improved when using the elevation angle 
correction to allow for the Earth's curvature, but the filter 
without the correction still performs almost as effectively. 
(The BO EKF, of course, is not affected by the correction 
since it does not use elevation angle as an input) . As 
angle measurement precision increases, the positive effect 

of an elevation angle correction to the BE EKF also increases, 
however (e.g.. Tables I and II, J(4,4) = 40^, P = .1^) . 

7. Table IV illustrates the effects of biased measure- 
ment data on EKF performance. When azimuth angle, or both 
azimuth and elevation angles have a bias, then neither 
filter operates effectively. When only the elevation angle 
is biased the BE EKF performance is severely degraded. Only 
the P = .25 measurement precision was investigated; it was 
felt to be a good test case since it consistently produced 
among the best results with unbiased inputs. 

C. TIME SEQUENCE PLOTS 

Figure 4.1 is a set of plots showing a time sequence of 
range errors during the 5 minutes of tracking. The median 
values of range errors are represented for the 1000 repli- 
cations of each of the different levels of measurement pre- 
cision (P) . A representative set of plots are shown in 
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Figure 4.1. 



Median Range Error Vs. Time — "Flat-Earth" 
Model, Range Variance = lOOnm 
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Figure 4.1 which are for the "flat-Earth" motion model with 

2 

range variance of lOOnm . Similar plots for the other sets 
of parameters are included at the end of the chapter. Note 
that the horizontal axis is not always at zero range error, 
and that the vertical scales differ among plots. In each 
plot the solid line represents BO EKF results, whereas the 
dotted line represents those from the BE EKF. 

Several important features of the EKF's are illustrated 
by the plots: 

1. The BE EKF is again seen to be generally superior to 
the BO EKF. The major advantage of the BE EKF seems to be 
the generally greater speed with which the estimated range 
converges to true range particularly in the lower measure- 
ment precision cases. At very fine measurement precision 

2 

(P = .01 and P = .0004 degrees ) there seems to be little 
if any advantage to using both bearing and elevation angles. 

2. In all cases the trend seems to be toward better 
convergence with time, once the initial transients have 
disappeared. This suggests that even in those cases where 

a large proportion of the runs are "dropped tracks" according 
to the range or range-velocity criterion, additional tracking 
time, if available , would bring increasing numbers into 
convergence. Limited additional computer simulations seemed 
to bear this out. 

3. The "humps" which are especially prominent in the 
2 2 

P = 2 , 1, and .5 cases occur at about 2 and 4 minutes. 
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They indicate that range error is decreasing from time 0 to 
1/ increasing from time 1 to 2, decreasing again from 2 
to 3, etc. Referring to Figure 3.1 (Fighter and Target 
Flight Paths) the convergence of estimated range to true 
range, then, appears to increase as the rate of bearing 
change increases. This is consistent with the well known 
(among submariners) result that in passive ranging "the 
greater the time rate of change of bearing the more accurate 
the range estimate" [Ref. 9] . This rate is slowest (with 
this particular geometry) when the fighter first turns in 
toward target flight path, increasing until he next turns in 
from the opposite side of target flight path. The humps, 
then, roughly coincide with the times at which the fighter 
is turning back in, i.e., the times when bearing change 
rate is relatively low. 

4. It is evident that the time to convergence is greatly 

affected by angle measurement precision. Note that in the 
2 

P = .02 case convergence is extremely rapid after 1 minute, 
which is the time of the first fighter turn. This suggests 
that in the case of extremely good precision, convergence 
time can be even further decreased by making the fighter's 
first turn earlier, or perhaps having the fighter maintain 
a constantly turning flight path such as the "sine wave" 
flight path proposed by Ohlmeyer [Ref. 1] . Limited addi- 
tional simulations with the fine precision and an earlier 
turn did, in fact, indicate that convergence time would be 
reduced. 
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Figure 4.2. 



Median Range Error Vs. Time — "^lat-Earth" 
Model, Range Variance = 1600nm"^ 
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Figure 4.3. 



Median Range Error Vs. Time — "Flat- 
Earth" Model/ Range Variance = 400nm2 
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Figure 4.4. 



Median Range Error Vs . Time-Spherical 
Model, Range Variance = 1600nm 
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Figure 4.5. 



Median Range Error Vs. Time — Spherical 
Model, Range Variance = 400nm2 
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Figure 4.6. 



Median Range Error Vs. Time — Spherical 
Model, Range Variance = lOOnm^ 



40 



MEDIAN range error (NM) MEDIAN RANGE ERROR (NM) 



P - 4 P - 1 





Figure 4.7. Median Range Error Vs. Time — Spherical 
Model (No Elev. Correction) , Range 
Variance = ISOOnm^ 
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Figure 4.8. Median Range Error Vs. Time — Spherical 
Model (No Elev. Correction) , Range 
Variance = 400nm2 
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Figure 4.9. Median Range Error Vs. Time — Spherical 
Model (No Elev. Correction) , Range 
Variance = lOOnm^ 
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V. CONCLUSIONS AND REC014MENDATI0NS 



A. CONCLUSIONS 

Computer simulations using the two EKF algorithms 
presented here demonstrate that both have the potential 
to be valuable tools for air-to-air passive ranging as 
long as their assumptions are met. The bearing-elevation 
EKF generally performs better than the bearing-only EKF 
when the fighter and target have a significant separation 
in altitude. 

B. RECOMMENDATIONS 

There are several possible EKF modifications which seem 
to offer potential in improving its performance. Some of 
these are: 

1. Filter re-initialization when it is determined to 
be grossly in error. Aidala [Ref. 8J , discusses ways in 
which "premature covariance collapse" can be recognized. 

He notes that onset of this malady, which usually leads 
to a dropped track, often occurs after only two initial 
measurements. This suggests that if it can be recognized 
there would normally be ample time to restart the EKF. He 
also cautions that some "previous attempts to prevent ab- 
normal filter behavior have proved ineffectual when sub- 
jected to rigorous testing .. .because they focus only on 



44 



the symptoms of the problem (rather than) the underlying 
causes" [Ref. 8]. 

2. Filter self-correction when obtaining "unbelievable" 
results. Although this may fall into the category of 
treating the "symptom" rather than the ailment, it seems 
reasonable to put some bounds on the acceptable estimated 
target state based on physical knowledge. The most obvious 
limit would apply to a low target; for example a fighter 

at an altitude of 3nm with a target elevation observation of 
-4° could immediately deduce that the target is (depending 
on measurement precision) no farther away from him than 
R ^ 3 CSC 4° = 43nm, since he can generally be assiamed to 
be above the Earth's surface, so it would seem futile to 
waste more time estimating him at, say, 80nm. Similarly, 
the maximiam altitude of a target taay be known, as well as 
possible limits on speeds, ranges, or headings. These 
things would be scenario-dependent and would probably re- 
quire aircrew inputs and reasonable default values. 

3. Increased frequency of observations (filter cycle 
rate) . A five-second interval was chosen for these simula- 
tions because that seemed long enough to ensure independence 
among measurements in an operational system, and because it 
reduced the computer time required to do the many replica- 
tions. A few simulations using three-second and one-second 
intervals obtained slightly faster convergence though little 
improvement in the n^Jmbers of dropped tracks . 
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4. Optimized fighter PR maneuver. Since the rate of con- 
vergence to the true target state evidently increases with 
the rate of bearing angle change, this should be considered 
in choosing fighter maneuvers. A pure collision course is 
not conducive to good passive ranging, especially for the 

BO EKF, since it precipitates no bearing change, but an 
alternating lead-lag, for instance, may accomplish virtually 
the same thing tactically, yet allow sufficient bearing 
change for a PR solution. The "optimum" maneuver would 
undoubtedly be different for varying scenarios and equip- 
ments. Altitude and speed changes as well as horizontal 
turns should be considered. The APL program (Appendix E) 
used to model these EKF's can be easily modified to accommo- 
date different fighter and target flight paths, and so could 
be a useful tool in comparing PR maneuvers. 

5. P-values (observation precision) adjusted to actual 
equipment specifications. This may entail varying the 
P-values as a function of range. Simulation results using 
this change are shown in Reference 1. Other equipment -peculiar 
characteristics such as own-ship navigation error would also 
have to be considered. For these simulations it was assumed 
that the distribution of angle measurement errors was known. 

The effects of giving the EKF wrong precision error distri- 
bution information should be investigated. 

6. Interactive system. The aircrewman may have a 
variety of sources of a priori information with which to 
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make an initial or updated estimate of target state. There 
should be a means for him to insert this information along 
with a confidence level or estimated variance, and, as 
mentioned above, there should be a set of reasonable default 
values . 

7. Measurement variance reduction. For example, several 
measurements could perhaps be averaged to obtain one obser- 
vation input which is less affected by individual outliers. 

This could be particularly important for the first few 
observations, since as Aidala [Ref. 8] suggests, they are 
so influential in the "premature covariance collapse" 
problem. 

8. Maneuvering target recognition and tracking. This 
continues to be an unsolved problem. Ohlmeyer [Ref. 1] , 
suggests "that small levels of target acceleration can be 
accommodated within the filter (using methods such as) the 
introduction of state process noise." 

9. Parallel filters. If computer capacity is available, 
it may be advantageous to have more than one EKF operating 
at the same time on the same target. The separate filters 
might use alternating observation inputs, or perhaps initialize 
at different times. Besides rendering a "second opinion" 

this could be helpful in the maneuvering target situation. 

10. Multiple target processing. Since fighter maneuvers 
need not generally be precisely designed for a specific 
target, the fighter could be making his maneuvers against 
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a particular, perhaps primary, target, and concurrently be 
computing passive ranging solutions on other targets if 
his equipment has sufficient sensor capability and computer 
capacity . 

11. Elevation angle-only EKF. There could be situations 
for which the fighter would want to maintain a collision 
course in azimuth (precluding bearings-only passive ranging) 
and yet desire a PR solution. This could conceivably be 
accomplished with altitude changes and an EKF which requires 
only elevation angle observations. 
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APPENDIX A 



VALIDATION 



A. VALIDATION METHOD 

The method of validation used here is borrowed from 
Daly [Ref. 6] . In essence, validity is claimed if the EKF 
tracks in range variance as well as in range. 

If the EKF is operating properly and if it is being 
provided with accurate enough information, then the esti- 
mates of range variance after individual tracking sessions 
should be very close to the true range variance. Compari- 
sons of the EKF variance estimates over many tracking 
sessions with the actual (sample) variances provide a means 
of evaluating the consistency of the EKF range estimates. 

As a measure of this consistency we will use the statistic 
Kl which is the ratio of sample range variance to EKF- 
estimated range variance at the end of a tracking session, 
averaged over n distinct sessions. 



Kl 



1 

n 







2 

-) 



is the EKF range estimate, R^ is the true range, and 

2 

is the EKF range variance estimate, all at the end of 
i 

tracking session i. The tracking session is simulated 
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n = 1000 times using the same values for all input param- 
eters, but using distinct random number streams for measure- 
ment errors and initial state estimate errors. The method 



We expect that if our theory is correct and the EKF 
has accurately estimated the true range variance, that the 
value of Kl will tend toward unity. 

The EKF algorithms were applied to the same passive 
ranging problem (scenario) which was addressed in Reference 
6. In this problem the observer and target are both surface 
ships. At time 0 the target bears 090° at 20nm. The target 
proceeds on a course of 360° at 10 kts, while the observer. 



2 . 

for computing R and is described below in Section C 

K 



TABLE V 



Kl Values — Surface Ship Scenario 



Flat-Earth Motion Model 



1000 Replications 




P 



^(4,4) = 10^ 
0.982 



1(4,4) = 1 



1.015 



0.957 

0.991 



0.953 



0.015 



0.985 



0.959 



1.140 

3.750 

7.461 



0.947 



1.048 



1.075 



0.976 

0.955 

1.091 

1.086 

0.941 

3.348 
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for his passive ranging maneuver, proceeds on a course of 
180° for 15 minutes, then turns (instantaneously) to a course 
of 360° for another 15 minutes. A total of 11 observations 
are taken at 3 minute intervals. 

B. VALIDATION RESULTS 

Table V illustrates that the K1 values do indeed 
generally tend toward unity, thus supporting our claim of 
validity. It is notable that with extremely fine measure- 
ment precision the Kl values no longer stay near 1. This 
finding was also reported in Reference 6. As discussed in 
Chapter IV, this seems to be a result of the range variance 
decreasing because of the fine precision, whereas the actual 
range errors are apparently limited in their decrease by 
the errors inherent in the EKF due to its linearization 
approximation in the Measurement Step. 

Results in Reference 6 were obtained using an EKF 
parameterized with range, bearing, velocity, and direction, 
rather than X, Y, X- velocity, and Y-velocity as used here. 
The author reports that he had obtained similar results 

using the latter parameterization, but that when using the 

• • 

(X,Y,X,Y) parameterization the Kl values stayed close to 1 
for a higher degree of measurement precision. Results con- 
tained here appear to confirm that. 

When this same technique was applied to the scenario 
described in Chapter III the resulting Kl values were less 
clearly convergent to 1 (Table VI) . While being somewhat 
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TABLE VI 



Kl Values — Fighter Scenario 

Flat-Earth Motion Model 
1000 Replications 



p 


j;(4,4) = 40^ 


Bearing-Only 
J(4,4) = 20^ 


1(4,4) = 


5^ 


0.981 


0.893 


0.897 


2 

2 


0.932 


0.882 


0.873 


1 


0.904 


0.868 


0.835 


.5^ 


0.853 


0.840 


0.833 


.1^ 


0.851 


0.799 


0.834 


.02^ 


0.938 


0.843 


0.826 


P 


1(4,4) = 40^ 


Bearing & Elevation 
1(4,4) = 20^ 


1(4,4) = 


5^ 


1.090 


0.964 


0.900 


2^ 


0.893 


0.846 


0.832 


l2 


0.839 


0.826 


0.837 


.5^ 


0.831 


0.801 


0.774 


.1^ 


0.889 


0.816 


0.823 


.02^ 


1.146 


0.983 


0.829 



"close” to 1 (±0.2) the Kl values varied from 1 signifi- 
cantly more than those for the simpler problem (±0.05). 
Only those values which were less than 10 were included in 
this computation of the average Kl's; this was done to 
eliminate the effect of those (normally few) dropped track 

g 

Kl values which diverged drastically from 1, e.g., 10 , 



52 



due to the much larger number of iterations per tracking 
session. This limit was picked arbitrarily and may partially 
account for most of the average Kl's being less than 1. 

The variation in the values seems to infer that the rate of 
convergence is scenario-dependent in that it is affected 
by the speeds, distances, and geometry involved. 

C. COMPUTATION OF RANGE VARIANCE 

The covariance matrix for this type of parameterization 

has terms for X, Y, and A (as well as X and Y) but not for 

2 

range itself, so the variance of the range, a^, is not 
provided directly, but is obtained as follows; 

For the bearing-only cases, with R, and R^ repre- 

senting range, and X-and Y-components of range respectively 



R = (R^ + 



SO 



3R _ ^X , 8R _ ^ 
dR^ R ' SR^ R* 



The first-order (linear) Taylor Series approximation 
(where indicates an estimated value) is: 



R = 









therefore 



R 



= ( 



9R 



9R. 



X 



,2 2 

) 



+ ( 4 §-) ( 



9R 






3R 2. 2 
^Y 
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or, substituting for the partial derivatives. 



2R^R^Cov(R^,Ry) + 
R 



Similarly, for the bearing-elevation cases, since 



R 



= + 4 ) 1/2 



then 

^R ^ ^(Rx^x 2R^RYCov(Rj^,RY)+R^ay+2RYR^Cov(RY,R^) 
R 

+ R^a^+2R^R^Cov { Rj^ , R^) ) . 



Note that Cov(Rj^,Ry) = Cov(X,Y) where X and Y are the target's 
X and Y coordinate positions, since the fighter (observer) 
position is known. 
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APPENDIX B 



EKF REFERENCE FRAMES AND MOTION MODELS 

A. "FLAT-EARTH" REFERENCE FRAME 

The EICF ' s for both the bearing-only and bearing- 
elevation observation models are set in a Cartesian 
coordinate system with axes X, Y and A. This reference 
system has its origin at 0 altitude directly beneath the 
fighter at time 0 (time of initial observation) , and Y-axis 
in the direction of the first observed bearing. Bearing 
and course are measured in the X-Y plane clockwise from the 
Y-axis • 

B. MOVEMENT IN THE "FLAT-EARTH" MODEL 

Since altitude is held constant for the fighter and the 
target, movement is a two-dimensional problem. For example 
if a target is at position (Xj^,Y^,A^) at time 1 , and at time 
2 has moved D units on a course of C, then his new position 
(X2/Y2,A2) is computed by: X2 = X^ + D sin C, ^2 ~ ^1 

and Aj^ = A2 . 

C. SPHERICAL REFERENCE FRAME 

Although the EKF algorithms presented here utilize a 
Cartesian (flat-Earth) reference frame, the algorithms are 
also tested using fighter and target positions generated by 
a spherical model. Here the Earth is modeled as a perfect 
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sphere of radius 3444 nautical miles. "Constant" course in 
this model means a great circle track with constant alti- 
tude; speed refers to ground speed, i.e., the speed of the 
object's projection on the Earth's surface. 

For computational ease a reference system is again based 
on fighter location and bearing to the target at time 0. 

The origin of this (latitude, longitude, altitude) spherical 
coordinate system is defined as the zero-altitude point 
directly beneath the fighter at time 0, and the initial 
observed bearing to the target is defined to be 0. (This 
may be thought of as shifting the Earth's coordinate system 
so that the intersection of the equator and the Greenwich 
Meridian is directly beneath the fighter at time 0, and the 
first observed bearing is True North) . 

D. MOVEMENT IN THE SPHERICAL MODEL 

In computing movement in the spherical system the 
following rules of spherical trigonometry are used (refer 
to Figure B . 1) : 

Law of Sines: 

sin g _ sin g _ sin y 
sin A/E sin B/E sin C/E 

Law of Cosines : 

cos B/E = cos A/E cos C/E + sin A/E sin C/E 
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Figure B.l. Spherical Trigonometry Reference 

cos 6 = - cos a • cos y + sin a • sin y • cos B/E 

where E is the Earth's radius. 

If in this coordinate system a target has position 
( latitude , longitude, altitude) = and Great 

Circle course at time 1 , and if by time 2 it has moved D 
units at constant altitude, the new position (X2,Y2,A2) 
and course C2 are computed by: 

Y2 = sin ^{sin Y^^ • cos D + cos Y^^* sin D - cos C^) 

X2 = ^(sin D ♦ sin cos Y2) 

C2 = (it - cos ^{sin • sin (X2~X^) • sin Y - cos C^*cos (X2~Xj^) 

(C^ T lC 3 _l) 
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Figure B.2. Spherical Movement 
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A 
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A 
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APPENDIX C 



FIGHTER MANEUVERS 

Only one set of fighter maneuvers are analyzed in this 
study. Some types of maneuvers are certainly better than 
others and the EKF algorithm has been demonstrated to be 
robust enough to operate well with a wide variety of 
different maneuvers; the essential features are that there 
be some variation in motion parameters [Ref. 9] and that the 
fighter be able to determine with reasonable precision his 
own position. 

The fighter maneuvers used for these simulations are as 
follows : 

(a) Upon initial target observation he immediately 
(instantaneously) sets a course 0.7 radians (about 40 
degrees) left of the first bearing observation. 

(b) The fighter maintains a constant course (constant 
speed and altitude with no horizontal turns — in the spheri- 
cal model this is a Great Circle track) until either a 
pre-set number of new observations have been taken, or until 
the relative bearing angle to the target exceeds 0.96 
radians (about 55 degrees) right. At this time he turns 
(again instantaneously) to establish a new course 0.7 
radians to the right of the most recent bearing observation, 
and similarly continues until relative bearing exceeds 0.96 
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radians left or until a set nuir±)er of observations have been 



taken. 

(c) This not-quite-syinmetrical zig-zag pattern continues 
until a set number of total observations have been recorded 
or until the target has passed the fighter (bearing obser- 

7T TT 

vation angle less than - or greater than y) . 
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APPENDIX D 



ELEVATION ANGLE CORRECTION FOR EARTH'S CURVATURE 



The Extended Kalman Filter algorithms proposed here were 
developed based on a "flat-Earth" motion model. To enhance 
the performance of the bearing-elevation EKF when using 
inputs from a spherical motion model, a simple, approximate 
elevation angle correction was developed. 

Referring to the figure on the next page, the notation 
is as follows; 

a = true elevation angle measured from the 
horizon 

a ' = "corrected" elevation angle to be input to 

the EKF 



R = line-of-sight range 

E = radius of the Earth (assimed here to be 
3444nm) 



Then 



A,p = altitude of target 

A = altitude of fighter 

r 

6 -j" + ct , 

At - ^F 

a ' - [ — 5 ] by construction 

X\ 

a' = [ — 5 ] by small angle sine approximation 

R^+(E+A )^-(E+A,^)^ 

sin(-o) - sin(j--$) > cos B - [ ; R (E+A,) ’ 

F 

by law of cosines 
R^+(E+Aj.) ^-(E+A 

“ ' ‘ 2~ R T e T a^) ' ‘’i' Sine 

approximation 
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Figure D.l. Elevation Angle Correction 



A -A R^+(E+A )^-(E+A 

a '-a = [-V-^] + [ o 1 ^ /s ] 



R 



2 R (E + Ap) 



R^-A^+2A^Ap-A^ 

2 R (E+Ap) 

so, since A_ and A„ are "small" and their difference is 
T F 

"small*' 



a ' - a 



R 

2E 
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so a ' 



= a + 



2E 



is the correction (based on EKF-estimated 



range) . 



NOTE: As the magnitude of A„-A„ increases relative to 

i r 

range, the approximation becomes less accurate, but as 
range decreases the correction goes to zero. 
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APPENDIX E 



APL COMPUTER PROGRAM 

The APL program shown here assumes global variables 
as defined in the initial comment section. The program 
updates fighter and target positions as described in 
Appendices B and C, generates random observations, and 
computes corresponding BO and BE EKF estimates. Choice of 
output variables and programming of output statistics is 
left to the user. 
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Cl] • VARIABLE DEFIHITIOHS 

C2] K DISTAMCES (SPEEDS) ARE IH HM (KTS) -r3444 

C3] • ANGLES, COURSES, BEARINGS ARE IN RADIANS 

C4] A 2 end of variable NAME INDICATES BE (VICE BO) 

C53 A INITIAL ESTIMATED MATRICES (AND AFTER MOVEMENT) 

C63 A P^HIJ MATRICES 

[7] M sigh; estimated matrices after measurement 

C8] A XU: INITIAL ESTIMATED STATE VECTOR (AND AFTER MOVEMENT) 

C9] A NH; ESTIMATED STATE VECTOR AFTER MEASUREMENT 
CIO] A **1»**2J DIAGONAL ELEMENTS} Q; 0 MATRICES 
Cll] A MW, MV, MR, MX, MA,; 

C12] A hmu,dh,mh; 

C13] A FUNCTION WHICH CALLS A N\(0,1) RANDOM HUMBER 

[14] H delt; time between observations in hours 

C15] A nh; number of observations between turns 

C16] A P’S? fcrs; fighter coordinates, speed, course 

C17] A lsrg, brg; true line-of-sight range and bearing to target 

CIS] A TX, TY, ta, ts, tcrs; target coordinates, speed, course 

C19] A TXD, tyd; tgt x and y velocities 

C20] A THRG; true HORIZ range ( flat-earth motion MODEL) 

C21] A GCRG; true great circle range (spherical motion MODEL) 

C22] A FRUH, TRUN; distance covered by fighter, target IH DELT 

C23] A = 1 (0) IF" ELEVATION CORRECTION APPLIED (NOT APPLIED) 

C24] A S = 1 (SN = 0) IP USE SPHERICAL MOTION MODEL 

C25] A 5 = 0 (SM = 1) IF USE FLAT-EARTH MOTION MODEL 

C26] A tela; true elevation angle 

C27] A VAL = 1 ; MU, MU2 INITIALLY RANDOM ABOUT TRUE STATE 

C28] A = 0 J MU2 SET AT SPECIFIC NUMERIC ESTIMATES 

C29] A 

C30] A IHITIALIZATION 
C31] A 

[323 GCRGH-2)e(((FA+l)»2) + ((TA+l)t2)-l-SRG»2)^2X(PA+l)xTA+l 

[33] THRG«-((LSRG<l2)-(TA-FA)»2>*0.5 

C34] FRUH«-DELTxFS 

[35] TRUH«.DELTXTS 

[36] BRG«.-lxMV[i;]+RAN[(2+2XNUM)]xR[l} 13*0.5 
C37] tcrs4-brg+tcsx(91)t180 

C38] TXt- ( Sx ( “3 ) a ( 3 eocRG ) x leBRO ) +snxthrgx l 9BRG 
C39] TY4-(Sx(-3)a| (iaTX)x3e(Q0.5)-BRG)+SHxTHRGx2eBRG 

[40] TXDfTSxlOTCRS 

[41] TYD«.T5x2aTCRS 

[42] TELAf. (Sx("2)0(TA+1)x( 1 aOCRG ) rLSRG ) +SNX ( “3 ) 0 ( TA-FA ) iTHRG 

C43] Z<-0fTE«-A+RAN[(3+2xHUM)3xRR[2f2]*0.5 

[443 ^Lx\VAL=o 

[45]. RAHVfRAN RAN RAN RAN RAN 

C46] 4 1 fxu2«- 5 1 f ( (tsx( (laTCRS) ,2aTCRS) ) ,o,thrg,ta)+ranvxsigrad»o.5 

C47] A 

C48] A measurement 
C49] A 

[50] A EQUATIONS 2.2 - 2.4 PO* bearing-only 

[51] ‘-;mrk(((mx<-mu[3}3)-fx)*2)+((my<.mu[4}3)-fy)*2)*0.5 

[52] HMUt. 1 1 f r 3 ) 0 ((MX-FX).rMY-FY) 

C53] 1 4 rO»0»((KT-FY)^MR*2),(PX-MX)^MR*2 

[54] k^.sigi+,x(^dh)+,xB((dh+.xsigi+.x(^0H))+r[1}i3) 

C55] XH«-(4fl)pMU+K + .x(((l,l)fZ[13)-MV+HMU) 

C56] SIGHt.(((4,4)/>(l,4fO))-K + .xDH) + .x5IGl 

[57] A 

[58] A EQUATIONS 2.2 - 2.4 POR BEARING-ELEVATION 

[59] MR2H(((MX2«.MU2[3;i])-PX)*2)+((XY2«-MU2[4}l])-PY)*2)»0.5 

[60] HMU24- 2 1 f ((■3)O<(MX2-FX)^MY2-FY)),(-3)0((MA2t-MU2[5}])-PA)rMR2 

C61] »H2F0,0f ( (MY2-FY)iMR2»2)f ( (PX-MX2)-rMR2»2) f0f0»0 

[62] PH2«-DH2, ( ( FA-MA2 ) X ( MX2-FX ) -r ( MR2 a3 ) +XR2X ( MA 2 -FA ) »2) 

[63] »H2<-DH2 , ( ( FA-MA2 ) X ( MT2-FY ) -r ( MR2* 3 ) +MR2X ( MA 2 -FA ) *2 ) 

C64] PH2»- 2 5 fI'H2,(MR2)r((MR2*2) + (»*A2-FA)»2) 

C65] K2HSi02+.x(^i»H2))+,xa((i'H2+.xsiG2+.x^DH2)+RR) 

[66] MH 2 f 5 1 fMU2+K2+.x((2 1 f z)-mv 2 +hmu 2 ) 

[67] sigh 2K(5 5 f (lf5f0))-'<2+.xr>H23+,xsiG2 

[ 68 ] A 
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C693 H-i+1 

[70] 4LCXI1HUM 

C71] A 

C72] A MOVEMEHT 
C733 A 

[74] A EQUATIONS 2.5f2.6 P'Oft BEARING-ONLY 

[75] lc;mo«.(PHh.,xmh)+mi» 

C76] sioikphi+,xsigh+.x^phi)+q 
C77] A 

C78] A equations 2.5f2.6 bearing-elevation 

[79] MU2f (PHI2+,XNH2)+MW2 

[80] sig2«-(phi2+,xSigh2+,xUPHI2)+02 
C81] A 

C82] A UPDATE FLAT EARTH 
C83] A 

C84] -»i-ux\s 

C85] TXfTX+TRUHxlOTCRS 

[86] TY«.TY+TRUNx2eTCRS 

[87] FXfFX+FRUNxieFCRS 

[88] FyfFY.|.FRUNx2eFCR5 

[39] THRG«.(((TX-FX)«2) + (TY-FY)»2)tO*5 

[90] lsrg<-((thrg*2)+(ta-fa)*2)*0.5 

[91] BftGt.(-3)0(TX-FX)iTY-FY 
C92] T.ELAf(-3)0(TA-FA)iTHRG 
[93] 4LLU 

C94] A 

C95] aupdate spherical earth 
C96] A 

[97] LUtTYf Cl )e( ( leTY)x 20 TRUN)+( 28 TY) X ( leTRUN) xTCRS 
C98] F'fF ( ”1 ) 0 ( ( lePY ) X29PRUH ) + ( 2 ofy > x ( igfrun ) xFcrs 

[99] TX«.TX+(-l)0(l9TRUN)Xl9(TXXFTX).r2eTYY«.TT 

[100] FX«.FX+.(-l)0(l0FRUN)xl9(FXXfFX)i29FYYFFY 

[101] TCRSf(xTCRS)x(9l)-C2)9( (19TCRS)X(19TX-TXX)X19TYY)-(29TCRS)X29TX-TXX 

[102] FCRSf ( xFCRS )X(9l)-C2)9((l 9 FCRS ) X ( 19 FX-FXX ) x 1 9 FYY ) - ( 29FCRS ) X29FX-FXX 

[103] GCRG«.(-2)9((10TY)xl9FY)+(29TY)x(29FY)x29TX-FX 

[104] lsrg<.(((fa+i)*2)+((TA+i )»2)-2x(FA+i)x(Ta+i)x29GCRG)»o,5 

[105] BRGfCI )9(29TY) X ( 19TX-FX)^10GCRG 
C 106] TELAf ( “2 ) 9 ( TA+ 1) X ( 19GCRG ) ^LSRG 
C107] A 

[108] LLUJ4JJX\FY<TT 
C109] «-P;40 

[110] JJ:Z«-(BRG+RAH[I]xRl),(TELA+RAN[((2xHUM)-I-l)]xR2)+ETRG2xFr2 
till] Jffcrs 

[112] fcrs«.(Jx(hh<turh)a(Ij-2C1])(0,96) + ((Z|:1]+0.7)x((nn=turn)a((j-Z[1])(0))v( 

j- 

ZCl])<*0.96)+(Za]-0.7)X((HN=TURN)A((J-2[l])>0))v(J-Z[l])>0,96 

C113] NNfl+NHxFCRS=J 
C114] -fL 

7 
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